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Abstract 

In  this  paper  we  propose  and  analyze  two  algorithms  to  monitor  an  environmental  boundary  with 
mobile  sensors.  The  objective  is  to  optimally  approximate  the  boundary  with  a  polygon.  In  the  first 
scenario  the  mobile  sensors  know  the  boundary  and  the  approximating  polygon  is  defined  by  the  sensors 
positions.  In  the  second  scenario  the  mobile  sensors  rely  only  on  sensed  local  information  to  position 
some  interpolation  points  and  define  an  approximating  polygon.  For  both  scenarios  we  design  algorithms 
that  distribute  the  vertices  of  the  approximating  polygon  uniformly  along  the  boundary.  The  notion  of 
uniform  placement  relies  on  a  metric  inspired  by  known  results  on  approximation  of  convex  bodies.  The 
first  algorithm  is  proved  to  converge  in  the  case  of  static  boundaries  whereas  the  second  one  is  provably 
convergent  also  for  slowly-moving  boundaries  because  of  certain  input-to-state  stability  properties. 


1  Introduction 

In  recent  papers  much  attention  has  been  given  to  the  problem  of  boundary  estimation  and  boundary  tracking 
by  means  of  robotic  networks.  In  particular  the  common  goal  is  to  design  an  algorithm  that  allows  a  limited 
number  of  mobile  sensors  to  detect  the  boundary  of  a  region  of  interest  and  estimate  it  as  it  evolves.  The 
reason  of  so  much  attention  lies  in  the  numerous  applications  that  boundary  estimation  and  tracking  can  be 
used  for.  Detection  of  harmful  algae  bloom  [1,  2],  oil  spill  [3],  and  fire  boundary  estimation  [4,  5]  are  just  some 
examples.  In  [1],  Bertozzi  et  al.  adopt  the  so  called  “snake  algorithm”  from  the  computer  vision  literature  to 
detect  and  track  the  boundary  of  harmful  algae  bloom.  The  agents  are  equipped  with  a  chemical  sensor  that  is 
able  to  measure  concentration  gradient  and  with  a  communication  system  that  is  able  to  exchange  information 
with  a  data  fusion  center.  In  [2],  Kemp  et  al.  suggest  an  algorithm  that  requires  only  a  concentration  sensor: 
the  agents  repeatedly  cross  the  boundary  using  a  bang-bang  angular  velocity  controller.  In  [3]  the  authors 
use  a  random  coverage  controller,  a  collision  avoidance  controller  and  a  bang-bang  angular  velocity  controller 
to  detect  and  surround  an  oil  spill.  In  [4,  5]  Casbeer  et  al.  describe  an  algorithm  that  allows  LASE  (Low 
Altitude  Short  Endurance)  Unmanned  Vehicles  to  closely  monitor  the  boundary  of  a  fire.  The  LASEs  have 
an  infrared  camera  and  a  short  range  communication  device  to  exchange  information  with  other  agents  and 
to  download  the  information  collected  onto  the  base  station.  The  algorithm  presented  will  uniformly  space 
the  LASEs  along  the  boundary  of  the  fire  so  that  eventually  they  will  patrol  an  equal  portion  of  the  perimeter 
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of  the  fire.  A  different  approach  is  considered  by  Zhang  and  Leonard  in  [6] .  A  formation  of  four  robots  tracks 
at  unitary  speed  the  level  sets  of  a  field.  Their  relative  position  changes  so  that  they  optimally  measure  the 
gradient  and  estimate  the  curvature  of  the  field  in  the  center  of  the  formation.  The  center  of  the  formation 
moves  along  the  level  sets. 

In  this  paper  we  propose  two  algorithms  to  estimate  and  reconstruct  the  boundary  of  a  region.  In  the  first 
idealized  scenario  we  assume  that  the  agents  have  knowledge  of  the  boundary  and  that  they  are  equipped 
with  GPS  and  communication  devices. 

In  the  second  scenario,  we  require  a  group  of  Unmanned  Air  Vehicles  (UAVs)  to  optimally  place  some 
interpolation  points  on  the  boundary  of  a  region  of  interest.  The  boundary  can  then  be  reconstructed  by 
linear  interpolation  of  the  interpolation  points.  We  assume  that  (i)  the  UAVs  do  not  have  a  priori  knowledge 
of  the  boundary,  (ii)  they  are  equipped  with  a  camera  sensor  and  with  algorithms  to  estimate  the  tangent 
and  curvature  of  the  boundary,  and  (iii)  a  wireless  communication  network  provides  the  UAVs  with  the 
ability  to  download  and  upload  the  interpolation  points  from  and  to  a  data  center.  The  algorithm  is  provably 
convergent  also  in  the  case  of  slowly-moving  boundaries  because  of  certain  input-to-state  stability  properties. 

The  novelty  of  this  paper  is  in  the  criterion  used  to  optimally  place  robots  and  interpolation  points  in  the 
first  and  second  scenario  in  such  a  way  that  they  are  uniformly  distributed  according  to  a  curvature- weighted 
distance  function  defined  along  the  boundary.  The  curvature-weighted  distance  function  was  inspired  by  the 
literature  on  optimal  approximation  of  convex  bodies  by  polygons  e.g.,  see  the  survey  [7,  8]. 

The  convergence  of  both  algorithms  is  proven  using  tools  from  the  theory  of  consensus  algorithms.  An 
incomplete  list  of  relevant  literature  references  includes  [9],  [10],  and  [11].  In  [10],  Blondel  et  al.  propose  an 
extension  to  Wolfowitz  Lemma  used  in  Jadbabaie  et  al.  [9].  The  authors  prove  that  an  infinite  product  of 
stochastic  matrices  (belonging  to  an  infinite  set,  and  with  diagonal  terms  uniformly  lower-bounded  by  a  pos¬ 
itive  constant)  converges  to  a  rank-one  matrix  (despite  bounded  communication  delays)  if  the  corresponding 
graphs  are  jointly  strictly  connected.  In  [11],  Moreau  uses  set- valued  Lyapunov  functions  and  gives  necessary 
and  sufficient  conditions  to  reach  consensus  in  both  directed  and  undirected  graphs.  It  is  required  that  a 
node  is  connected  to  all  other  nodes  (less  restrictive  condition  than  the  one  in  [10])  across  some  bounded  or 
possibly  unbounded  interval  (respectively  for  undirected  and  directed  graphs),  and  that  the  dynamic  mapping 
is  strictly  convex. 

The  paper  is  organized  as  follows.  In  Section  2  we  review  some  mathematical  literature  on  approximation 
theory  and  convex  optimization.  In  Section  3  we  introduce  the  curvature-weighted  deployment  algorithm 
for  the  case  of  known  boundaries.  In  Section  4  we  introduce  an  algorithm  to  jointly  update  an  environment 
boundary  and  deploy  the  UAVs  uniformly  along  the  boundary  estimate.  In  Section  5  we  present  our  final 
concluding  remarks. 


2  Preliminaries 

In  this  section  we  review  some  known  useful  results  from  approximation  and  matrix  theory. 


2.1  Approximation  of  convex  and  non-convex  curves 

A  lot  of  work  has  been  done  to  characterize  the  best  polygon  approximating  a  strictly  convex  body,  e.g., 
see  the  extensive  surveys  [7,  8].  In  the  standard  literature  on  convex  bodies  approximations,  the  symmetric 
difference  between  two  compact,  and  strictly  convex  bodies  C,  B  is  defined  by 

S^{C,  B)  =  n{C  UB)-  ^i{C  n  B), 

where  /x  is  the  Lebesque  measure  on  If  Q  is  the  body  to  be  approximated  by  an  inscribed  n- vertices 
polygon  P„,  then  6^{Q,Pn)  =  /x(Q)  —  For  n  sufficiently  large,  McLure  and  Vitale  [12]  show  that 
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where  P*  is  the  best  approximating  polygon  with  n  vertices  inscribed  in  Q,  dQ  is  the  boundary  of  Q,  p  and 
K  =  p~^  are  the  curvature  radius  and  curvature  of  the  boundary,  respectively,  £  is  the  arc  length  along  dQ, 
and  6  is  the  angular  position  in  a  polar  variable  parametrization  of  dQ.  It  is  not  an  easy  task  to  construct  the 
best  approximating  polygon  P*  for  a  strictly  convex  body,  but  McLure  and  Vitale  in  [12]  suggest  the  method 
of  empirical  distributions.  According  to  this  method,  the  positions  9i,  i  S  {1, . . .  ,n},  of  the  n  vertices  along 
dQ  have  the  property  that  D^{i)  =  p{9)'^/^d9  has  the  same  value  for  every  consecutive  pair  of  vertices 

{i,i  +  1).  Interpolating  polygons  computed  according  to  the  method  of  empirical  distributions  converge  to 
P*  as  n  ^  +00. 

For  smooth  non  convex  bodies  with  a  small  number  of  saddle  points,  the  method  of  empirical  distributions 
will  also  yield  a  nearly  optimal  distribution  as  n  ^  +oo  because  of  the  local  convexity  of  the  body.  We  show 
how  to  do  this  in  what  follows.  Since  the  curvature  radius  p  may  be  unbounded  at  some  point  of  a  non- 
convex  boundary,  the  integral  D^{i)  may  be  unbounded  for  some  i.  We  avoid  this  problem  by  considering 
the  following  general  notion  of  distance  along  a  boundary.  For  A  G  [0, 1],  we  define  the  pseudo-distance  D\ 
between  vertices  (i,  i  +  1)  by: 


Pi+i 

Dxii)  =  X  /  K{ey/^di  +  (1  -  A)(£i+i  -  Q). 

Jti 

This  definition  is  inspired  by  the  fact  that,  for  convex  bodies,  we  have  pi9)°‘  =  Jqq  K{£y~°'di,  see  [7]. 
Introducing  the  convex  combination  with  arc  length,  we  guarantee  that  D\{i)  is  non-zero  whenever  the 
vertices  i  and  i  -I-  1  do  not  coincide.  In  what  follows  we  shall  apply  a  version  of  the  method  of  empirical 
distribntions  in  which  the  positions  of  any  two  consecutive  vertices  of  the  interpolating  polygon  are  uniformly 
distribnted  according  to  the  pseudo-distance  D\. 

We  conclude  this  section  by  remarking  that  a  metric  similar  to  D\  is  used  by  Chen  et  al.  in  [13,  14]. 
In  this  paper,  interpolation  problems  are  motivated  by  certain  diffusion  phenomena  in  singularly  perturbed 
systems.  The  authors  show  that  quasi-optimal  interpolation  errors  in  the  Loo  or  Li  norm  are  achieved  when 
the  grid  is  uniform  in  the  f  or  f  tQl^dl  metric,  respectively. 

2.2  Metzler  matrices 

We  begin  by  introducing  some  definitions  and  notations  taken  from  Chapter  5  in  [15].  For  A  € 
we  let  A  y  (P)0  denote  that  the  elements  of  A  are  positive  (resp.  non- negative) .  For  A  G  we  let 

A  >  (resp.  >)0  denote  that  the  matrix  A  is  positive  definite  (resp.  positive  semidefinite)  and  we  let  p(A)  be 
the  spectral  radius  of  A. 

Definitions  1.  {ij  A  square  matrix  is  said  to  be  of  class  Z  if  all  of  its  off-diagonal  elements  are  non¬ 
positive. 

(it)  A  square  matrix  A  of  class  Z  is  said  to  belong  to  class  K  if  there  exits  a  matrix  C  P  0  and  a  number 
k  >  p{C)  such  that  A  =  kl  —  C . 

(Hi)  A  square  matrix  A  of  class  Z  is  said  to  belong  to  class  Kg  if  there  exists  a  matrix  C  ^  0  and  a  number 
k  >  p{C)  such  that  A  =  kl  —  C . 

Matrices  of  class  K  and  Kg  are  called  M- matrices  (Metzler  matrices).  Note  that  equivalent  definitions  of 
matrices  of  class  K  and  Kg  are  provided  in  [15].  We  briefly  recall  that  a  matrix  A  is  irreducible  if  and  only 
if  its  associated  directed  graph  is  strongly  connected.  The  following  theorem  presents  a  few  useful  properties 
of  these  matrices. 

Theorem  1.  (i)  If  A  G  Z  and  if  there  exists  x  >-  Q  such  that  Ax  >:  0,  then  A  G  Kg. 

(a)  If  A  G  belongs  to  the  class  Kg,  is  irreducible  and  singular,  then  there  exists  u  y  0  such  that 

Au  =  0.  Moreover,  rank(A)  =  n  —  1. 
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(in)  If  A  G  Ko,  then  every  eigenvalue  of  A  has  nonnegative  real  part. 

Theorem  1  is  proved  in  Theorem  5.11,  5.8  and  5.3  in  [15],  respectively. 

Next  we  present  a  novel  application  of  these  concepts.  For  a  g]0,  1],  let  ki  G  [a,  1]  for  all  t  G  {1, . . .  ,n}, 
and  dehne  the  n  x  n  square  matrices 


A{ki,...,kn)  = 


0 


0 

ks 


kn 


ki 

0 


-kn  -  ki 


and  B{ki, . . . ,  kn)  =  {in  +  A{ki, . . . ,  kn)Y  —  In-  These  matrices  have  the  following  useful  properties. 

Lemma  2.  The  matrices  A{ki, . . . ,  kn)  and  B{ki, . . . ,  kn)  have  rank  n  —  1  and  their  eigenvalues  have  non¬ 
positive  real  part. 


Proof.  Let  M  =  —A{ki, . . . ,  kn)  so  that  M  €  Z.  By  Theorem  l(i)  with  x  =  1,  it  can  be  seen  that  M  G  Kq. 
Moreover  M  is  irreducible  because  represents  a  strongly  connected  graph,  and  singular  because  Ml  =  0.  We 
can  then  apply  Theorem  l(ii)  which  proves  that  the  origin  is  an  eigenvalue  of  M  with  multiplicity  1.  With 
Theorem  l(iii)  hnally  it  can  be  proved  that  M  is  positive  semidefinite  which  implies  that  A(ki, . . .  ,kn)  is 
negative  semidefinite.  The  same  proof  applies  to  B(ki, . . . ,  kn).  □ 


3  Interpolation  with  global  information 

In  this  first  section  we  propose  and  analyze  an  algorithm  that  uniformly  distributes  the  agents  according  to 
the  pseudo-distance  introduced  in  the  previous  section.  We  assume  that  the  agents  have  complete  knowledge 
of  the  contour  of  a  body  they  have  to  approximate.  The  approximation  set  is  obtained  by  linear  interpolation 
of  the  positions  of  the  agents,  hence  it  will  be  called  interpolating  polygon.  We  prove  convergence  when  the 
contour  is  time  invariant. 


3.1  Problem  setup  and  notation 

Let  ||x||  denote  the  Euclidian  norm  of  x  G  M".  If  x  is  a  scalar,  then  juj  denotes  its  absolute  value.  Let  1R+ 
be  the  set  of  non  negative  real  numbers  and  No  =  N  U  {0}.  Let  dQ  be  the  boundary  of  a  connected,  and 
possibly  non-convex  set  Q  in  Let  7:  [0,1]  ^  be  a  parametric  representation  of  the  boundary;  we 
assume  that  7'(s)  7^  0  for  all  s  G  [0, 1],  that  7(0)  =  7(1),  and  that  s  increases  as  we  traverse  the  curve  in  the 
counterclockwise  direction.  We  define  the  curvature  k:  [0, 1]  ^  R+  of  the  curve  7  by 


k(s) 


IIY(^)x7"(^)II 

||7'(s)||3 


Let  pi,. . .  ,pn  G  R^  be  the  locations  of  n  robots.  Let  TTj  G  dQ  C  R^  be  the  point  on  the  boundary  closest 
to  the  robot  pi,  i.e., 

TTi  =  argmin^gag  \\pi  -  z||, 

and  let  Si  G  [0, 1]  satisfy  j{si)  =  tt^  (see  Figure  I).  The  projection  might  not  being  unique  for  some  dQ 
and  some  positions  pi.  We  choose  randomly  among  all  possible  projections  of  pi.  Let  L:  dQ  x  dQ  R+ 
be  the  arc  length  along  the  boundary  dQ  between  two  points  measured  in  the  counterclockwise  direction 
starting  from  the  first  argument,  i.e.. 


L{t^1,T^2) 


\h'{s)\\ds, 
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where  =  7(5^),  k  S  {1, 2}.  Given  A  G  IR+,  let  Dx :  dQ  x  i9Q  ^  R+ ,  be  the  pseudo-distance  defined  by: 

Dx{Tri,Trj)  =  X  f  K'^^^{s)\\j{s)\\ds  +  {l-X)L{TTi,Trj), 

J  Si 

where  tt^.  =  7(5^),  k  G  Occasionally  on  we  will  use  the  identifications  L{si,Sj)  =  and 

D\{s„Sj)  =  DxiTTi,TTj),  where  =  jisk),  k  G  {i,j}. 

Now,  given  n  points  {tti,  . . . ,  7r„}  G  dQ  we  can  construct  the  Voronoi  partition  of  dQ  based  on  the 
pseudo-distance  Dx-  For  a  point  tt^  we  define  Ui  the  position  of  its  immediate  counterclockwise  neighbor  as 
follows:  Ui  =  7(s“)  =  TTj,  where  j  =  argmin^gij^^  „jL(7rj,7rq).  Analogously,  we  define  ii  as  the  position  of 
its  immediate  clockwise  neighbor  as  follows.  Q  =  7(sf)  =  tt^,  where  j  =  argmin^g|]^  L(7rg,7rj). 

We  associate  any  agent  with  its  Voronoi  cell  Vi  =  {7(3)  |s  G  where  mf  and  m“  are  defined 

implicitly  as  follows:  Dx{sl,m^)  =  Dximj,Si)  and  Dx{si,mf)  =  Dx{mf,sf).  Furthermore,  we  let  fif  = 
7(to“)  and  /rf  =  For  any  Voronoi  cell  we  define  its  center  Ci  =  7(5*),  where  s*  is  implicitly  defined 

by  Dx{ml,  s* )  =  Dx{s*,m'^).  Finally,  we  define  the  set  of  the  neighbors  of  agent  i  according  to  a  disk  graph: 
A/i  =  {j  G  {1, . . . ,  n}[  \\pj  —  Pill  <  r}.  All  the  quantities  just  defined  are  illustrated  in  Figure  1. 


Figure  1:  In  this  figure  pi,  pj,  pk,  Po,  and  pt  and  their  projections,  TTi,  ii,  Ui,  tTq,  and  ttj  onto  the  boundary 
dQ  are  illustrated.  There  are  also  indicated  the  midpoints  pf  and  /x“,  according  to  the  pseudo-distance  Dx 
between  ii  and  TTi,  and  between  TTi  and  Ui.  Vi  is  the  Voronoi  cell  associated  with  agent  i,  and  the  Voronoi 
center  is  Ci.  L{ii,Tri)  and  L{TTi,Ui)  are  the  arc  length  of  the  portion  of  dQ  between  ii  and  tt*,  and  between 
TTi  and  Ui- 


3.2  Curvature-weighted  Deployment  Algorithm 

In  this  section  we  present  and  analyze  an  algorithm  that  will  allow  n  robots  to  be  equally  distributed, 
according  to  the  pseudo-distance  Dx,  along  the  boundary  of  Q.  In  other  words,  the  objective  is  to  distribute 
the  robots  in  such  a  way  that  their  Voronoi  cell  has  pseudo-length  equal  to 

=  (a«^/^(s)  +  (1-A))  \h'{s)\\ds. 

The  algorithm  is  summarized  in  the  following  table. 
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Name:  Curvature-weighted  Deployment  Algorithm 

Goal:  Uniformly  distribute  the  agents  according  to  the  pseudo-distance  D\. 

Data:  Parametric  representation  of  the  boundary,  7. 

Between  two  communication  rounds,  local  agent  i  G  {1, . . . ,  n}  performs: 

1:  Calculate  its  projection  tt^. 

2:  Acquire  the  projections  iTj  for  j  €  Mi- 
3:  if  Ai  7^  0,  then 

4:  determine  its  immediate  counterclockwise  and  clockwise  neighbors,  i.e.,  set 

:=  TTj,  where  j  :=  argmin^g_;V'i 

Ui  :=  TTj,  where  j  :=  argmin^g_^.  L(7ri,  tt,), 

and  calculate  the  center  of  its  Voronoi  cell  Ci, 

5:  else 

6:  Ci  :=  TTi- 

7:  end  if 

8:  if  Pi  ^  dQ,  i.e.,  the  agent  is  not  on  the  boundary,  and  Ci  ^  tt^,  then 
9:  first  move  towards  tt^  then  towards  Ci,  following  the  tangent  to  dQ  at  tt^. 

10:  end  if 

11:  if  Pi  ^  dQ,  i.e.,  the  agent  is  not  on  the  boundary,  and  Ci  =  tt^,  then 
12:  move  towards  tt^. 

13:  end  if 

14:  if  Pi  S  dQ,  then 

15:  move  towards  Ci  sliding  along  the  boundary  dQ. 

16:  end  if 

Theorem  3.  If  the  communication  radius  r  is  larger  than  the  diameter  of  Q,  then  the  Curvature- 
weighted  Deployment  Algorithm  guarantees  that,  for  all  i  e  {1, . . .  ,n}, 


lim  Dx{si,St+i) 

t — »-  +  CXD 


lim  D\(si 

t — »-  +  oo 


i  5  '^i+1 


)=Dl 


(1) 


Proof.  The  algorithm  assures  that  the  agents  will  reach  the  boundary  at  some  point,  so  without  loss  of 
generality  we  will  assume  that  pi  =  Hi  £  dQ  for  all  i  G  {1, . . . ,  n}. 

The  first  equality  in  equation  (1)  is  true  because  the  agents  always  move  towards  their  Voronoi  center  so 
we  have  to  prove  only  the  second  equality.  By  hypothesis  r  is  larger  than  the  diameter  of  Q,  this  guarantees 
that  J\fi  =  {1, . . . ,  n}  \  {z}  for  all  i  G  {1, . . . ,  rz}.  Furthermore  {£i,  Ui}  are  the  correct  neighbors  of  agent  i  for 
all  z  G  {1, . . . ,  n}  in  the  ring  topology  graph.  Then,  without  loss  of  generality,  we  can  relabel  all  the  agents 
so  that  they  are  in  increasing  order  if  we  move  along  the  boundary  in  the  counterclockwise  direction.  Hence, 
agents  z  -I- 1  and  z  —  1  are  the  clockwise  and  counterclockwise  neighbors  of  agent  z  for  all  z  G  {1, . . . ,  rz}.  This 
means  that  Tr^+i  =  Ui  and  TTi-i  =  ip,  we  use  the  convention  7r„+i  =  tti,  and  ttq  =  7r„.  Let  /zf  =  7(rzzf)  be  the 
midpoint  between  the  projections  7ri_i  and  tt^  according  to  the  pseudo-distance  D\{Tri-i,Tri),  then 

Dx{Tri-i,Pi)  =  Dx{pi,T^i)  =  ]^Dx{T^t-i,TTi).  (2) 

Analogously,  let  /z“  =  7(rzz“)  be  the  midpoint  between  the  projections  and  Tr^+i  according  to  the  pseudo¬ 
distance  Dx{'Ki,T^i+i),  then 

D\{TTt,pf)  =  Dx{^Jf:,^T^+l)  =  ]^Dx{^T^,'^:,+l).  (3) 

By  definition  of  Voronoi  center  Ci  we  have: 


DxiplC,)  =  Dx{Ci,p:) 


2 


(4) 
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Substituting  (2)  and  (3)  in  (4): 


44;,(/xf,Q)=i^A(Q,/i“) 


Dx{Tri_i,Tri)  +  Dx{ni,Trt+i) 

4 


The  pseudo-distance  between  Ci  and  can  be  now  calculated  as  follows: 

Dx{Ci,  TTi)  =  Dxifif,  TTj)  —  Dxifif,  Ci),  if  Ci  is  encountered  when  going  from  /i^  to  tt^, 

DxiiTi,  Ci)  =  DxiTTi,  fii)  —  Dx{Ci,  fii),  if  Ci  is  encountered  when  going  from  tt^  to 

Equations  (6)  and  (7)  refer  to  the  two  different  situations  described  in  Figure  2. 


(5) 

(6) 
(7) 


Figure  2:  The  center  Ci  of  the  Voronoi  cell,  associated  with  agent  i,  can  be  to  the  left  (upper  arc)  or  to  the 
right  (lower  arc)  of  the  projection  tt^  of  the  point  pi. 


Recalling  (2),  (3),  and  (5),  (6)  and  (7)  become: 

7-,  \  Dx{T^i  —  l,T^i)  ~  Dx{T^i,T^i+l) 

—  ~A  5 


if  Ci  is  encountered  when  going  from  p,\  to  TTj,  (8) 


Dx{TTi,  Ci)  =  i,T^i)  +  Dx^TTijiTi+i)  ^  encountered  when  going  from  to  (9) 

According  to  the  algorithm,  agent  i  slides  along  the  boundary  with  constant  velocity  towards  Q  and  it 
reaches  the  position  .  The  pseudo-distance  Dx  between  the  position  of  agent  i  between  two  communication 
rounds  can  be  expressed  as  follows: 

DxiTT^jTTi)  =  Dx{nt,Tri+i)  ^  encountered  when  going  from  to  tt^,  (10) 


DxiT^i,T^t)  = 


,  if  Ci  is  encountered  when  going  from  to  /i“,  (11) 


where  a  <  ki  <  1,  with  a  being  the  uniform  lowerbound  on  fc^s  only  after  the  agents  reach  the  boundary. 

In  the  same  way  we  can  calculate  Dx{T^t_i,T^i-i)  or  Dx{T^i-i,'!rf_i)  according  to  the  relative  position 
between  TTf_i  and 


71a  (^i— 2  5  1 )  71a  (tT^— 1 ,  TTj  ) 


(12) 


7 


Dx{Tr^-i,Trt_i)  =  ki-i 


(13) 


-£>A(7r^_2,7ri_i)  +  Dx{Tri-i,ni) 

4 


We  can  now  express  the  new  pseudo-distance  between  and  as  a  function  of  Dx{Tri-i,ni).  As  shown 
in  Figure  3,  there  four  possible  cases  to  take  into  account.  For  each  of  them  Dx{n^_i,TT^)  is  expressed  as 
follows: 


Dx{tt+_^,tt+) 


Dx{Tri-i,'!^z)  +  D\{n,Trt)  -  easel  , 

Dx{Tri-i,TT^)  -  Dx{Tr:l,TT^)  +  DxiTr:l_;i^,Tr^-i),  case  II  , 
HA(7ri_i,7rj) -b  F>A(7ri,7r+) -b  i:>A(7r)ti,7rj_i),  case  III  , 
Dx{Tri-i,Tr,)  -  HA(7r+,7rj)  -  F'A(7ri-i, case  IV  . 


(14) 


case  I 


case  II 


case  III 


case  IV 


Figure  3:  In  this  figure  the  four  possible  relative  positions  between  tt"*',  tt^,  and  tt^-i  are  shown. 


Substituting  (10),  (11),  (12),  and  (13)  in  (14): 


-DA(7r)ti,7r+)  =  ^^^i:»A(7ri_2,7r,_i)  -b  (1  -  -  j)Dx{tt^-i,tt^)  +  ^Dxi^:i,^T^+l), 


(15) 


for  all  the  four  cases.  If  we  now  call  D  the  column  vector  obtained  by  stacking  up  the  pseudo-distances 
Dx{'!Ti_i,Tri)  for  all  i  S  {1, . . .  ,n},  and  D+  its  update,  then: 


D+  =  (/„  +  A(A:i/4,...,A:„/4))D, 


(16) 


where  A(fci/4, . . . ,  fc„/4)  was  defined  in  Section  2. 

We  need  to  be  able  to  express  a,  lower  bound  of  kiS,  in  order  to  apply  the  results  of  [11].  Since  the 
vectors  7^(s),  and  k{s)  are  defined  on  a  compact  set,  their  modulus  has  a  maximum  and  a  minimum  value. 
Let  llTmaxll)  llTminll)  ll^maxlj,  and  ||«:min||  be  the  maximum  and  minimum  values  of  the  norm  of  j'{s)  and  k{s). 
Let  us  suppose  now  that  agent  i  has  to  slide  along  the  boundary  dQ  from  the  position  to  position  tt^  at 
speed  V  in  the  sampling  time  At  >  0,  then: 


V  = 


L{7Ti,7T+)  _  f";  h'lMs 


At 


At 


V  < 


Il7(naxllk+-^i) 

At 


vAt 


(17) 


We  can  lower  bound  and  upper  bound  the  quantity  Dx{7Ti,TT^)  recalling  (11): 


jDx{dQ)  >  Oxiiruiri)  =  Ak3  Ijy'lj -b  (1  -  A)||7'||(ts  >  AkV^||7V„|| -b  (1  -  A)||7V„||  (s+ -  s*). 


We  can  write: 


^D^idQ)  > 


A||Kinin|h  +  (1  A)  ||7min  II  (S' 


Si)  > 


l^  +  (l-A) 


The  lowerbound  on  ki  can  be  evaluated  as  follows: 


fcj  >  4 


A||/«mi„||3  +  (1  -  A)  ||7;„ 


DxidQ) 


Il7m 


-vAt  =  a. 


Given  the  boundary  dQ,  the  speed,  and  the  sampling  time,  a  can  be  calculated.  If  the  speed  v  is  very  large 
then  a  could  be  larger  than  1.  This  means  that  any  agent  can  move  in  a  sampling  interval  from  a  point  on 
the  boundary  to  any  other  point,  then  the  lowerbound  on  ki  is,  as  the  upperbound,  equal  to  1. 

We  can  now  use  Theorem  3  of  [11]  and  the  fact  that  the  dynamic  matrix  A{ki, . . . ,  fc„)  in  equation  (16) 
is  doubly  stochastic  to  complete  the  proof.  □ 

Remark  4.  Instead  of  relying  on  the  results  in  [11],  we  sketch  here  an  alternative  proof  given  by  a  direct 
Lyapunov  argument.  IfVfD)  =  (D  —  i4Jl)^(D  —  D[^l),  then 


V"(D+)  -  1/(D)  =  (D+)^(D+)  -  D^D  =  D^R(fci/4, . . . ,  fc„/4)D  <  0, 

where  B{ki/A, . . . ,  kn/A)  is  defined  in  Section  2.  Recall  that  l^D  =  1D+  =  D\{dQ)  and  that  the  dynamics 
matrices  are  symmetric.  It  can  he  proved  (see  Lemma  2)  that  all  the  eigenvalues  of  B(ki/ A, . . .  ,kn/ A)  have 
strictly  negative  real  part,  except  for  one  placed  at  the  origin.  The  eigenvector  associated  with  the  eigenvalue 
0  is  the  vector  1.  Using  the  LaSalle  Invariance  Principle  we  conclude  that  consensus  is  reached. 

Conjecture  1.  We  conjecture  that  Curvature-weighted  Deployment  Algorithm  achieves  consensus 
even  if  r  is  smaller  than  the  diameter  of  Q  but  larger  than  r* ,  where  r*  is  defined  by: 

r*  =  max  f  ||7'(s)IMs- 
e./e[0,l] 

D(e, /)  =  £>• 


The  lowerbound  r*  guarantees  that,  if  consensus  is  reached,  each  agent  can  communicate  with  its  immediate 
clockwise  and  counterclockwise  neighbors  (according  to  the  ring  graph,  i.e.,  the  neighbors  along  the  boundary). 
However,  before  consensus  is  reached,  a  possible  situation,  illustrated  in  Figure  f,  is  one  in  which  some  agents 
cannot  communicate  with  their  immediate  neighbors  and  some  agents  are  isolated.  Each  non  isolated  agent 
will  move  in  such  a  way  that  the  pseudo-distance  between  itself  and  its  clockwise  neighbor,  and  between  itself 
and  its  counterclockwise  neighbor  have  the  same  value.  As  a  consequence,  the  pseudo-distance  between  an 
agents  and  those  that  it  recognizes  as  its  neighbors  will  grow  and  potentially  will  be  larger  than  D\.  In  doing 
so  it  might  get  to  see  its  correct  neighbors  or  it  might  get  isolated  because,  at  a  certain  point,  the  euclidian 
distance  between  itself  and  its  last  neighbors  is  larger  than  r* .  Since  the  boundary  dQ  is  a  closed  set,  not  every 
agent  can  be  isolated  and  there  will  always  be  some  agent  that  can  detect  other  agents  and  move  accordingly. 
It  is  our  conjecture  that,  eventually,  every  agent  will  determine  its  correct  immediate  neighbors  according  to 
the  ring  topology  graph,  and  hence  consensus  will  be  reached. 


3.3  Simulations 

In  this  section  we  present  the  implementation  results  of  the  Curvature- weighted  Deployment  Algo¬ 
rithm  when  dQ  is  time-invariant  and  described  by,  for  6  S  [0, 1), 


7(0)  =  ^2  -I-  cos(lO7r0)  -I-  O.5sin(47r0)^ 


cos(27r0) 

sin(27r6*) 


(18) 
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Figure  4:  In  this  figure  four  agents  are  on  a  portion  of  the  boundary  dQ.  The  radius  of  communication  is 
r.  One  agent  is  isolated,  while  the  other  three  have  at  least  a  neighbor  according  to  the  disk  graph.  With 
knowledge  about  their  neighbors  in  the  disk  graph,  the  agents  are  not  able  to  correctly  identify  their  neighbors 
along  the  boundary. 


In  Figure  5  five  different  frames  of  the  simulation  are  collected.  The  frames  show  for  t  =  0,  t  =  0.25,  t  =  1, 
t  =  5,  and  t  =  25  the  positions  of  agents  and  the  boundary  dQ.  The  value  of  A  is  The  sampling  time  is 
t  =  0.05  seconds  while  the  radius  of  the  communication  disk  is  r  =  3. 

In  Figure  6  it  is  shown  the  error  n}  D\{pi,pi+i)  —  n}  D\{pi,pi+i)  in  the  consensus 

on  Dx  reached  by  the  agents.  The  difference  should  vanish  but  it  does  not  because  of  numerical  errors.  For 
example,  because  the  Voronoi  center  is  defined  implicitly,  the  agents  need  to  estimate  it  using  the  bisection 
method  and  this,  of  course,  introduces  addtional  error  in  the  evaluation  of  Voronoi  cell  and  Voronoi  center. 

4  Interpolation  with  local  information 

The  Curvature-weighted  Deployment  Algorithm  was  developed  under  the  assumption  that  all  the 
agents  have  complete  knowledge  of  the  boundary  dQ.  Here  we  consider  a  more  generic  and  realistic  scenario 
in  which  every  sensing  agent  has  only  local  knowledge  of  the  boundary  to  be  reconstructed.  We  suppose  that 
the  sensing  agents  can  locally  estimate  the  tangent  and  the  curvature  of  dQ.  For  the  case  of  UAVs  surveilling 
a  visible  boundary,  this  information  could  be  provided  by  a  camera  and  an  edge  detection  algorithm.  Another 
possibility  is  to  substitute  every  agent  with  a  formation  of  chemical  sensors.  In  the  recent  work  [6]  the  authors 
propose  an  optimal  formation  of  four  agents  to  estimate  the  gradient  and  the  curvature  of  a  given  level  set 
in  a  field.  We  assume  that  an  initial  estimate  of  the  boundary  is  available  so  that  the  interpolation  points 
can  be  distributed  (possibly  non  uniformly)  on  the  boundary  and  the  pseudo-distance  Dx  between  any  two 
neighbors  is  known.  We  assume  also  that  every  agent  is  equipped  with  wireless  communication  devices  to 
communicate  with  a  data  fusion  center. 

To  interpolate  the  unknown  slowly  time-varying  boundary  dQ,  we  introduce  a  counterclockwise  ordered 
set  of  interpolation  points  {pi, . . .  ,pn,^}.  These  are  virtual  positions  stored  in  a  data  fusion  center  together 
with  the  tangent  of  dQ  at  all  interpolation  points,  and  the  pseudo-distance  between  any  interpolation  point 
and  its  counterclockwise  neighbor.  The  agents  have  two  objectives:  (i)  update  the  interpolation  points  such 
that  they  are  uniformly  distributed  along  dQ  according  to  the  estimated  pseudo-distance  Dx,  (ii)  be  equally 
distributed  along  the  boundary  according  to  arc  length  distance. 

To  achieve  these  objectives  we  propose  a  novel  Estimate  Update  and  Pursuit  Algorithm 
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Initial  Configuration 


3 


t  =  0.25  sec 


Figure  5:  This  figure  shows  five  different  instants  of  25  seconds  simulation  obtained  by  implementing  the  Curvature- 
WEIGHTED  Deployment  Algorithm  with  n  =  30,  A  =  r  =  3. 
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max  Dx  —  min  Z)  \ 


Figure  6:  Curvature-weighted  Deployment  Algorithm.  The  plot  shows  the  error  Dx{pi,pi+i)  — 

DxiPi,Pi+i)  vs  time. 


that  can  be  summarized  as  follows.  After  reaching  a  point  on  dQ,  the  sensing  agents  move  along 
dQ  to  collect  the  following  data:  (i)  points  belonging  to  dQ,  and  (ii)  tangent  and  curvature  of 
dQ  at  those  points.  Using  these  measurements  and  communicating  with  the  data  center,  they 
complete  the  following  three  steps.  In  the  first  step,  they  determine  which  interpolation  point  Pi 
they  are  closer  to  and  then  project  it  onto  the  measured  boundary.  In  the  second  step,  they  adjust 
Pi-i  so  that  it  is  at  the  center  of  its  Voronoi  cell  along  dQ.  In  the  third  step,  they  estimate  the  arc 
length  of  distance  between  them  and  their  immediate  clockwise  and  counterclockwise  neighbors 
and  use  this  information  to  speed  up  or  slow  down.  The  first  two  steps  have  the  combined  effect 
of  updating  the  local  estimates  of  the  boundary.  Thanks  to  the  third  step,  the  agents  distribute 
themselves  uniformly  along  the  boundary. 

In  what  follows  we  present  the  Estimate  Update  and  Pursuit  Algorithm  in  some  detail  and  we 
analyze  its  stability. 

4.1  Problem  setup  and  notation 

Let  7:  M+  X  [0,1]  — >  be  a  parametric  representation  of  the  time- varying  boundary  so  that,  at  fixed 

t  G  R+  and  for  all  s  £  [0, 1],  'y{t,  s)  describes  the  boundary  at  time  t.  We  assume  that  =  7'(t,  s)  0 

for  all  s  G  [0,1]  and  for  all  t,  that  7(t,0)  =  7(t,  1),  and  that  s  increases  as  we  traverse  the  curve  in  the 
counterclockwise  direction.  We  also  assume  that  7(t,  s)  is  smooth  with  respect  to  s  and  t  and  that  the  length 
of  the  boundary  dQ  is  upperbounded  and  lowerbounded  uniformly  in  t. 

Let  pi, . . .  ,Pnip  G  be  the  locations  of  nip  ordered  interpolation  points.  Let  Pi{t),  with  i  G  {1, . . .  ,na} 
and  Rip  ^  Sria,  be  the  positions  of  the  sensing  agents  at  a  given  time.  Both  the  interpolation  points  and 
the  sensing  agents  are  ordered  counterclockwise.  We  assume  that  the  sensing  agents  move  counterclockwise 
along  the  boundary,  with  speed  Vi. 

We  assume  that  each  agent  maintains  some  variables  in  its  memory  that  are  described  as  follows.  The 
state  of  the  sensing  agent  i  is: 


{now®,  lastarc®,  bufferarc®,  nextbuffer®}, 

where  the  first  variable  is  a  counter,  and  the  other  three  are  a  discrete  representation  of  the  subset  of  dQ 
the  sensing  agent  is  flying  over.  For  simplicity  we  will  omit  the  upperscript  and  lowerscript  i  and  we  will 
introduce  them  when  necessary. 
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Let  NOW  g  {1,  ■  ■  •  ,nip}  be  the  next  point  to  be  projected  onto  dQ.  Let  O  =  lastarc  U  bufferarc  U 
NEXTBUFFER  C  dQ  be  the  set  of  observations  collected  by  the  sensing  agent  up  to  time  t  while  going  from 
Pnow-2  towards  Pnow  along  dQ  defined  as  follows: 

LASTARC  =  {oi,  .  .  .  ,  Ol}, 

BUFFERARC  =  {ol+i,...,Ol+m},  (19) 

NEXTBUFFER  =  {ol+m+1,  •  •  •  >  OL+M+t}) 

where  L,  M  G  N,  T  G  No,  oi  =  Pnow-2,  ol  =  Pnow-i,  and  ol+m+t  =  Pit)-  The  following  figure  illustrates 
these  notation  and  quantities.  The  solid  line  represents  dQ  as  seen  by  the  agent  i,  while  the  dashed  line 
represents  dQ  as  seen  by  the  agent  i  —  1.  The  sensing  agent  is  represented  by  a  triangle.  The  white  circles 
represent  the  interpolation  points  before  the  agent  updates  them,  whereas  the  black  circles  represent  the 
interpolation  points  after  the  agent  has  updated  them.  The  square  represents  the  last  point  belonging  to 
BUFFERARC.  The  first  and  the  last  point  of  the  three  data  structures  lastarc,  bufferarc,  and  nextbuffer 
are  shown,  the  others  are  omitted  for  clarity. 


current  agent/^  Pnow-2  —  o 
previous  agent 


ol+m 

Pi  =  Ol+m+t 


BUFFERARC 


nextblJffer 


Before  defining  the  point  ol+m  and  the  index  M  we  introduce  the  set  of  estimated  tangent  vectors  to 
dQ,  7':  (P  ^  and  the  set  of  estimated  curvature  of  dQ,  k:  O  ^  M+.  In  other  words,  Y{oj)  and 
Hioj)  are  estimated  tangent  vector  and  curvature  at  the  point  Oj,  for  j  g  {1, . . . ,  L  +  M  +  T}.  We  can 
now  define  D\:  0x0^  R.+  as  the  discretized  pseudo-distance  between  two  observations  oj  and  Oh,  with 
h,j  g  {1,...,L-|-M  -l-T},  and  h  >  j.  We  shall  characterize  implicitly  the  observation  ol+m  as  follows 

D\i0L+l,0L+M)  =  211))  (p  NOW— 1,  Pnow), 

where  il))(pNow-i,PNow)  is  the  estimated  pseudo-distance  between  p^ow-i  and  Pnow  when  an  agent  updated 
for  the  last  time  Pnow-  This  information  is  assumed  to  be  stored  in  the  data  center. 

The  sets  lastarc,  and  bufferarc  will  be  used  by  the  sensing  agents  to  define  the  projection  onto 
dQ  of  Pnow  and  the  Voronoi  center  Cnow-i  of  the  interpolation  point  Pnow-i-  We  recall  that  the  positions 
Ol, . . . ,  Ol+m+t  are  points  on  the  plane  that  the  sensing  agent  has  visited  in  previous  instants  while  moving 
along  the  boundary  dQ,  i.e.,  Oj  =  P(t)  for  some  t  <t  and  for  all  j  g  {1, . . . ,  L  -I-  M  -|-  T}.  We  can  say  that 
the  points  oi, . . . ,  ol+m+t  are  a  fine  discretization  of  the  portion  of  dQ  from  Pnow-2  to  the  current  position 
of  the  sensing  agent  P,  while  the  indices  Pnow-2,  Pnow-i,  and  Pnow  are  a  coarser  discretization  of  the  same 
arc. 

To  calculate  the  Voronoi  cell  Vnow-i  along  dQ  of  the  interpolation  point  Pnow-i,  we  first  need  to  project 
Pnow  On  dQ.  Let  oj  be  the  projection  of  Pnow,  defined  by: 

Pnow  ■“  ~  argmin^^. II  (oj  ~Pnow)  ■  InowIIj 

where  is  the  unit-length  tangent  vector  at  dQ{t~)  at  the  interpolation  point  Pnow  last  time 

II7  (Pnow)II 

the  interpolation  point  was  updated.  In  other  words  the  projection  of  Pnow  at  time  Y  on  dQiY)  is  the 
intersection  of  dQiY)  with  the  normal  vector  to  dQ{t~)  at  Pnow  at  time  t~ .  This  projection  is  univocally 
defined  and  has  the  following  properties.  If  dQ  is  time- invariant  then  Pno^^  =  Pitow)  T  is  slowly  time- varying 
then  Pnow  is  close  to  the  orthogonal  projection  of  Pnqw  oato  dQ{Y).  We  can  now  define  the  set  nowarc 
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and  update  bufferarc  as  follows:  nowarc  =  {ol+i,  •  •  • ,  oj},  bufferarc  =  bueferarc  \  {ol+i,  •  •  • ,  oj}. 
In  the  following  figure,  the  agent  (i)  projects  the  interpolation  point  Pnow  onto  dQ{t),  (ii)  update  the  state 
variable  bueferarc  and  generate  the  variable  NOWARC. 


LASTARC 

NOWARC 

BUFFERARC 

NEXTBUFFER 


Using  the  collected  data,  the  sensing  agents  can  numerically  evaluate  the  pseudo-distances  IIa(Pnow-2,Pnow-i) 
and  iIlA(PNow-i,PNow)  between  Pnow-2  and  Pnow-i,  and  between  Pnow-i  and  Pnow-  Recall  that  Pnow-2  =  oi, 
Pnow-1  =  ol-  Let  then  Unow-i  =  {oe,  ■  ■  ■  ,o„},  where  oe  G  lastarc  and  Ou  G  nowarc  are  implicitly  defined 
by: 


Dx{oi,Oi)  =  Dx{oi,OL)  = 


D\{oi,ol) 


Dx{ol,Ou)  =  Dx[Ou,Oj)  =  - - - . 

The  point  oi  is  the  midpoint  between  Pnow-2  and  Pnow-Ij  while  is  the  midpoint  between  Pnow-i  and 
Pnow  after  the  latter  was  projected  on  dQ.  We  can  now  implicitly  define  the  Voronoi  center  Cnow-i  :=  G 
LASTARC  U  NOWARC  by 


Dxioi,o^)  =  Dx{0k,0u)  = 


Dx{oi,ol)  +  Dx{ol,o-,) 


In  the  following  figure,  the  agent  (i)  calculates  the  Voronoi  cell  t4ow-i)  and  (ii)  updates  the  interpolation 
point  Pnow-1  to  lie  optimally  between  Pnow-2  and  Pnow 


Remark  5.  In  practical  settings,  the  sensing  agent  might  not  be  able  to  find  oi,  o„,  and  Cnow-i  that  exactly 
satisfy  the  equalities  above,  due  to  the  fact  that  the  sensing  agent  knows  only  a  discretization  of  dQ  through 
the  observations  lastarc,  nowarc,  and  bufeerarc.  To  handle  the  discretization,  one  can  redefine  oe,  Ou, 
and  Cnow-i  by: 


Dxioi,o,)  - 


oe  =  argmm^.gLASTARc 
Ou  =  argmin„.g„o„,,j,c 

Cnow-i  =  Ofe  =  argmin„.g|o^_ 


Dx{oi,ol) 


Dx{0i,0L)  - 


Dx{0L,0-j) 


Dx{oe,Oi)  - 


I  Dx{0L,0j)  +  Dx{oi,ol) 
[  4  ^ 
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The  sensing  agent  can  now  update  once  more  the  state  variables  as  follows:  NOW+  =  NOW+1,  lastarc’*'  = 

{o^,  .  .  .  ,Oj},  BUFFERARC’*'  =  ,  O^},  and  NEXTBUFFER+  =  {Og+i,  .  .  .  ,  Ol+M+t},  where  Oq  G  BUFFERARCU 

NEXTBUFFER  is  implicitly  defined  by:  B^(oj+i,Oq)  =  2D~(pr,ow+-i,PNow+),  if  ol+m+t)  <  2B~  (p„ow+-i,Pnow+) 

then  BUFFERARC+  =  BUFFERARC  U  NEXTBUFFER  and  NEXTBUFFER+  =  0.  The  following  figure  shows  the 
state  variables  update  as  just  described,  in  the  case  that  nextbuffer  =  0. 


1 

'  LASTARC  ' 

BUFFERARC  ' 

This  completes  our  description  of  the  estimate  update  algorithm  and  we  now  focus  on  the  pursuit  objective. 
To  uniformly  distribute  the  sensing  agents  along  the  boundary  dQ  according  to  arc  length,  we  will  use  the 
following  update  law  for  their  velocities: 


V^(t)  =vo  +  k(L(B,,P^+i)  -  L(Pi_i,Pi)), 

with  k,  Vo  >  0  and  L{P„,  P^)  =  Ei^ilow^+i  {\\pj-i  —  PjW),  for  all  n,m  G  ria}.  Here,  recall  that 

Pnow"  jPnow^+i  )  •  ■  •  jPnow™  are  the  interpolation  points  separating  agent  n  and  agent  m,  with  n  <  m.  L  is 
the  estimated  arc  length  of  the  portion  of  dQ  that  has  to  be  traversed  to  go  from  the  sensing  agent  n  to  the 
sensing  agent  m.  The  sensing  agents  have  only  local  information  of  dQ  but  still  they  have  to  estimate  the 
distance,  along  dQ,  from  their  clockwise  and  counterclockwise  neighbors  in  order  to  calculate  their  speed. 
The  estimate  L(Pn,Pm)  is  obtained  by  the  approximating  polygon  formed  by  the  interpolation  points.  In 
practice  any  agent  will  speed  up  if  it  is  closer  to  the  agent  behind  it,  and  slow  down  if  closer  to  the  agent  in 
front  of  it.  With  a  saturation-like  function:  sat(r!i(t))  =  max{ui„in,  inin{vi(t),  rimax}},  we  will  impose  though 
that  0  <  Vmin  <  Vi(t)  <  Umax  for  all  t. 

4.2  Estimate  Update  and  Pursuit  Algorithm 

In  this  section  we  present  an  algorithm  that  allows  Ua  sensing  agents  to  equally  distribute  the  riip  interpolation 
points  along  dQ,  according  to  the  pseudo- distance  B\.  Also  the  algorithm  uniformly  distributes  the  sensing 
agents  along  dQ,  according  to  the  arc  length.  The  algorithm  is  summarized  in  the  following  table. 


Some  steps  of  the  algorithm  are  affected  by  noise  and  error:  i)  7'  and  k  are  only  estimate  of  the  true 
values,  ii)  L  is  an  approximation  of  L,  iii)  the  sets  lastarc,  bufferarc,  and  nextbuffer  are  discretization 
of  the  subset  of  dQ  that  agent  i  is  visiting,  therefor,  the  center  of  the  Voronoi  cell  of  the  interpolation  point 
Pnow*-i  rnight  not  be  calculated  exactly.  Let  D(t)  and  L(t)  be  the  column  vectors: 

D (t )  =  [Bx{pi{t),P2{t)),  ■ .  ■  ,Bx - 1  (t ) , {t)),D\ (Pnip {t),pi{t))Y' , 

L(t)= 

Consider  now  the  disagreement  vectors  d(fc)  and  dL(t)  defined  as  follows: 


d{k) 

^  l^f>x{k) 

=  Dx(k)  1, 

(20) 

5L{t) 

=  m - ^1, 

ria 

(21) 
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note  that  they  are  orthogonal  to  the  vector  1. 

It  will  be  proved  that  the  dynamics  of  d  and  (5L  is  input-to-state  stable  (ISS)  where  the  inputs  are  the 
errors  and  noises  above  discussed.  Because  of  the  ISS  property  we  can  conclude  that  as  long  as  the  errors  are 
small,  the  states  D\{pi,pi^i)  and  L{Pi,  Pi+i)  will  be  close  to  the  equilibrium  of  the  unperturbed  system,  i.e., 
Dxipi,Pi+i)  =  Dx{p^+i,p^+2)  for  all  i  G  {1, . . .  ,nip}  and  L{P^,P^+i)  =  L{Pi+i,Pi+2)  for  all  i  G  {1, . . .  ,na}. 

Lemma  6.  Let  7:  [to, +00)  x  [0,1]  ^  describe  the  boundary  dQ  along  time,  and  let  dB{p,e)  be  the 
boundary  of  the  ball  centered  in  p  and  with  radius  e.  If  7(t,  s)  is  a  smooth  function  of  both  its  arguments, 
then  Ve  >  0  3T  >  to  such  that  \/p  G  dQ{to)  the  set  defined  by  dB(p,e)  n  dQ{t),  tg  <  t  <  T  ,  has  only  two 
elements. 

Lemma  6  implies  that  if  we  allow  small  enough  changes  in  dQ,  then  the  projection  of  any  interpolation 
point  Pi  onto  dQ{t),  as  defined  in  the  previous  section,  is  unique. 

To  avoid  abuse  of  notation,  let  D\{pi,pi^i,t)  be  the  pseudo-distance  along  dQ{t)  between  the  instan¬ 
taneous  projection  of  two  interpolation  points  onto  dQ(t).  Let  to  be  the  last  instant  of  time  in  which  the 
sensing  agent  measured  D\{pi,pi+i).  Then  the  error  \D\(pi,pi+i,t)  —  D\(pi,pi+i,to)\  is  bounded  and  the 
result  is  stated  as  follows. 

Lemma  7.  Let  7:  [<o,  T]  x  [0, 1]  ^  describe  the  boundary  dQ  along  time.  If  j{t,  s)  is  a  smooth  function 
of  both  its  arguments,  then  for  t  >  Q,  Dx{p^,p^+l,t)J=  Dx{pi,Pi+i,to)  +  g{t  -  Q)  for  all  z  G  {1, . . . 
where  g{t)  is  continuous  and  g(0)  =  0.  The  guantity  D\(pi,pi^i,t)  denotes  the  pseudo-distance  between  two 
consecutive  interpolation  points  at  time  t  given  that  they  were  projected  onto  dQ{t)  from  their  positions  at 
time  to.  The  number  t  —  Q  is  bounded  from  above  by  At  =  max^gg^  ^  ^/jg^g  y  jg  ^/jg  gpggg^  of  the 

agent. 

Lemma  7  is  due  to  the  fact  the  the  pseudo-distance  D\  is  the  composition  of  smooth  functions  and  only 
continuous  functions  in  t,  so  it  is  continuous  in  t.  Therefor,  if  the  boundary  changes  slowly,  then  the  corrective 
term  g{t  —  to)  is  just  like  a  noise.  If  we  can  prove  that  D\{pi,pi^i,t)  gets  close  to  the  target  value,  we  will 
prove  that  also  Dx{pi,Pi+i,t)  will  get  close  to  the  target  vector  due  to  Lemma  7. 

Theorem  8.  The  evolution  of  the  disagreement  vectors  defined  by  (20)  and  by  (21)  under  the  Estimate 
Update  and  Pursuit  Algorithm  is  input-to-state  stable  with  respect  to  estimation  noise  and  deformation 
of  the  boundary  dQ(t). 

Proof.  We  first  prove  the  ISS  property  for  the  dynamics  of  d{k). 

Let  us  suppose  that  dQ{t)  is  time-invariant,  that  no  error  affects  the  calculation  of  Cnow-i,  the  center  of 
the  Voronoi  cell  of  the  interpolation  point  pnow-i  (i-e.,  the  buffers  used  by  the  agents  are  continuous  and  not 
discrete).  Suppose  that  a  sensing  agent  has  passed  by  the  point  Pnow,  and  then  it  can  optimally  place  Pnow-i- 
As  a  consequence,  the  pseudo-distances  L*a(Pnow-2,Pnow-i)  and  L*a(Pnow-i,Pnow)  will  take  new  values  that 
can  be  expressed  as  follows,  (see  Figure  7): 

Dx{Pnov/-2j  Pnow— l)"*" 

D\{p  NOW—  1 5  PnOW  ) 


For  z  G  {1, . . 

. ,  rzip},  define  Aj  G  R" 

ipXriip 

1 

f3/4, 

ii  j  =  k  =  i,  or  j  =  k  =  i  —  1, 

(Ai)jfc  =  < 

1/4, 

if  j  =  z  —  I  and  k  =  i,  or  if  j  =  i,  and  fc  =  z  —  1 

otherwise. 

3  ^  1  ^ 

=  ^-^a(Pnow— 2)Pnow-i)  H"  ^-^a(p  NOW— 17  PnOw)5 

1  ^  3  ^ 

=  ^-^a(Pnow— 2)Pnow-i)  H"  ^-^a(p  NOW— 17  PnOw)- 
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Pnow-2 


D\  (PnOW-2  t^NOW-l 
2 


D\{p  NOW-1  ,Pmw)+D\{p  NOW— 1;PnOw) 
2 


Figure  7:  This  figure  shows  how  the  pseudo-distance  D\  between  Pnow-2  and  Pnow-i,  and  between  pnow-i 
and  Pnow  changes  after  agent  i  has  optimally  placed  Pnow-i- 


Then  the  Ai  are  the  dynamics  matrices  for  the  system 


DA(t2)  =  AiJUxlti), 

where  ^2  >  is  the  time  when  the  interpolation  point  i  is  moved  by  a  sensing  agent  to  its  new  Voronoi 
center,  assuming  that  between  ti  and  t2  no  other  interpolation  point  is  moved.  If  at  the  same  instant  more 
interpolation  points  are  relocated,  then  the  dynamics  matrix  is  the  product  of  all  the  Ai  that  correspond 
to  the  relocated  interpolation  points.  We  can  now  relax  the  assumptions  and  we  can  consider  slowly  time- 
varying  dQ.  Let  ti  be  the  /c-th  time  that  pi  is  optimally  placed  by  an  agent.  Before  optimally  placing  pi,  the 
agent  will  project  Pi+i-  Because  the  boundary  has  changed,  the  pseudo-distance  D\{pi,pi+i,ti)  will  differ 
from  Dx{pi,pi^i,ti^l)  by  some  noise  g{ti  — Therefore  the  system  is  evolving  according  to  a  dynamical 
system  of  the  form: 

DA(t?)+  =  A,  (DA(t,^)  -f  -  4-I))  ,  (22) 

where  is  the  column  vector  with  null  entries  but  the  i-th  component  that  is  equal  to  1.  Let  AT  = 
supjgg^  ^  since  by  assumption  the  length  of  the  boundary  dQ{t)  is  uniformly 

upperbounded.  This  means  that  at  most  after  AT  any  interpolation  point  is  updated  at  least  once.  Any  time 
that  an  agent  updates  any  interpolation  point  pi  the  vector  Da  evolves  according  to  (22),  where  is 

upperbounded  by  AT. 

Because  AT  is  finite,  there  exists  a  sequence  of  instants  t^,  with  fc  G  Nq,  such  that  across  the  interval 
[Tk-i,Tk]  every  interpolation  point  has  been  updated  at  least  once  by  an  agent.  In  other  words: 

nx{k  +  l)  =  Aik)'Dxik)  +  u{k),  fceNo,  (23) 

where  we  identify  tq  =  0,  and  =  k,  and  where  A{k)  =  Aj^,  jk  G  {I, . . .  ,nip}.  The  graph  associated 
with  A{k)  is  connected  and  A{k)  is  ergodic.  Furthermore,  A{k)  is  doubly  stochastic  because  the  product  of 
double  stochastic  matrices.  The  value  of  the  index  jk  depends  on  the  order  in  which  the  interpolation  points 
are  updated.  It  is  easy  to  see  that  nip  <  M{k)  <  naUip.  Consider  now  the  disagreement  vector  d(fc)  defined 
in  (20).  Recalling  (23),  and  that  A{k)  is  doubly  stochastic,  we  can  write  the  update  law  of  the  disagreement 
d(fc): 

d{k  +  l)  =  Aik)d{k)+6u{k),  fcGNo,  (24) 
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where  5u{k)  =  u(fc)  —  ^  1.  Because  A(k)  is  ergodic,  the  equilibrium  point  of  the  unperturbed  system  is 

the  origin  which  means  that,  if  u(k)  is  equal  to  0,  asymptotically  the  system  (23)  will  reach  ^ 

Let  V(d(k))  =  d(k)'^d(k)  be  a  Lyapunov  function  candidate  for  the  dynamics  of  d(fc).  Then: 

y(d(fc  +  1))  -  V(d(k))  =  -d(kfE(k)d(k)  +  Su(kfSu(k)  +  2Su(kfA(k)d(k), 

where  —R{k)  =  {^A{k)'^A{k)  —  Imp)-  By  Theorem  1  it  can  be  proved  that  R{k)  is  positive  semidefinite  and 
the  only  eigenvalue  at  the  origin  is  associated  with  the  eigenvector  1  that  is  orthogonal  to  d(fc). 

Let  Aq  be  a  generic  element  of  the  set  of  cardinality  nip!  +  (nip  +  1)!  +  •  •  •  +  (nipUa)!  containing  all  the 
possible  matrices  obtained  by  multiplying  M  matrices  Ai,  with  nip  <  M  <  UaUip  and  i  €  {1,  ■  •  •  ,nip},  such 

that  the  graph  associated  with  Aq  is  connected.  Let  =  {r  G  ]R|  det  (^rl^p  —  {A^Aq  —  Imp)^  =  0}  \  {0} 

and  Tq  =  minj  |r^|,  then  3  r  =  min^rg  <  0  because  we  are  considering  a  finite  set  of  matrices.  We  can  then 
upperbound  V{d{k  +  1))  —  F(d(A:))  as  follows: 

V{d{k  +  1))  -  V{d{k))  <  -a3(||d(fc)||)  +  a{\\6u\\), 


where  Q;3(||d(A:)|j)  =  ir||d(fc)|p,  (t(||(5u[|)  =  (|  +  l)||5u|p.  By  [16]  the  system  described  by  (24)  is  input- 
to-state  stable.  Since  the  system  (24)  is  ISS,  we  can  now  relax  the  assumption  that  no  error  effect  the 
calculation  of  Cnow-i  and  still  be  able  to  conclude  that  will  asymptotically  get  close  to  the  equilibrium  of 
the  unforced  system,  i.e.,  the  interpolation  points  are  uniformly  distributed  according  to  D\.  This  is  simply 
because  also  this  error  enters  linearly  in  the  system  (24). 

We  can  now  prove  the  ISS  property  for  the  dynamics  of  5L. 

Let  us  suppose  that  the  dQ(t)  is  time- invariant  and  that  the  sensing  agents  can  actually  compute  without 
error  the  arc  length  distance  between  them  and  their  clockwise  and  counterclockwise  neighbors.  The  dynamics 
for  L(t)  can  be  derived  as  follows.  Consider 


L{P^{t),P^+i{t))  =  Vi+i  -  Vi,  (25) 

where 


"Ci+l  —  Uq  3“  A:  (L  (^Pi^i ,  Pi^2  )  L  i^Pi  ,  Pi-\-l  )  )  , 

=vo  +  k{L  {Pi,  Pi+i)  -  L  (Pi_i,  Pi)) . 

Substituting  now  equations  (26)  and  (27)  in  equation  (25),  we  have: 

L{R{t),  R+i{t))  =  k(^L  (P,+i,  P,+2)  -  2L  {R,  P,+i)  +  L  (P,_i,  P,)  )  . 
If  the  saturation  on  the  speeds  is  not  active,  we  have: 


-  -2  1  0 

1  -2  1 

t{t)  =  k  :  •. 

0  ...  1 

.1  0  ... 


1  - 

...  0 

:  L{t)  =  kALUt). 

-2  1 
1  -2  . 


(26) 

(27) 


If  we  introduce  the  saturation  on  the  speeds  Vi,  then  the  dynamics  of  L  becomes: 

L(t)  =  kA{ci, c„^)L(t), 

where  g1(ci,  . . . ,  c„^)  is  defined  in  Section  2,  with  n  =  ria,  a  =  ^  To  calculate  the 

lowerbound  of  Ci,  a,  suppose  that  the  saturation  on  the  velocity  is  active  for  the  sensing  agent  i.  This  is 
equivalent  to  saying  that 

Vi  =  Vo  +  k{  {L{Pi,  Pi+i)  —  L{Pi_i,  Pi)) , 
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where  k[  =  kct,  Ci  <  1.  We  can  think  of  the  saturation  function  as  a  change  in  the  gain  in  the  control  law. 
If  Vi  =  Umax,  then 


k'  = 


^max  ^0 


> 


^max  '^0 


{L{Pi,  P,+i)  -  P,))  -  L{dQ) 


r  -  =  M  >  1  VQ  „ 

*  k  -  k  L{dQ) 


If  Vi  =  Umin,  then 


k'  = 


Vo  -  Wmiii 


> 


Vq  —  Umiii 


(L(Pi,  P,+i)  -  P(P,_i,  P,))  -  L(dQ) 


r-  =  M  >  1  ^0  '^min  „ 

*  k  -  k  L{dQ) 


Therefore  a  lowerbound  for  the  Ci  is  given  by  the  minjumax  —  votVq  —  Umin}  ■  It  can  be  proved  (see 

Lemma  2)  that  the  new  matrices  A{ci, . . . ,  c„^),  like  A^,  are  negative  semidefinite.  The  only  eigenvalue  at 
the  origin  is  associated  with  the  eigenvector  1. 

Let  us  consider  the  disagreement  i5L  as  described  by  (21),  then 


,5iL(t)  =  A(ci,...,c„J<5L(t), 


and  the  candidate  Lyapunov  function  V{S'L{t))  =  6L'^ {t)6L{t) ,  then 


(28) 


V{6L{t))  =  2SL{t)A{c„  c„J<5L(t)  <  0, 

where  the  equality  holds  only  if  the  entries  of  S'L{t)  are  all  zero.  Since  Ci  belong  to  a  compact  set,  the  matrices 
A{ci, . . . ,  c„^)  belong  to  a  compact  set,  and  since  the  eigenvalues  of  a  matrix  are  a  continuous  function  of  its 
entries  (see  [17])  then  there  exists  an  upperbound  —p  <  0  for  the  eigenvalues  that  are  different  from  zero  and 
as  a  consequence: 

V{6L{t))<-p\\6L{t)r. 

We  can  then  conclude  that  the  system  (28)  is  exponentially  stable. 

Let  us  now  analyze  how  the  pursuit  objective  can  still  be  achieved  when  the  boundary  is  slowly-varying 
and  when  the  instead  of  P(Pi,Pi+i)  the  agents  use  only  the  approximation  L{Pi,  Pi+i).  Let  Ud{t)  be  the 
vector  that  expresses  the  change  in  the  arc  length  distance  between  any  two  consecutive  agents  due  to  the 
deformation  of  dQ{t),  and  let  u[)"(t)  =  then 

Ud(t)  =  Sud(t)  +  u^^(t). 


Let  L“"(t)  =  then: 

^  '  "a  ’ 


L(t)  =  L“"(t)  +  ,5L(t)  =  L“"(0)  +  u7(t)  +  ,5L(<), 
and  taking  the  derivative  respect  to  time  of  both  sides  we  have: 

L(t)  =  ur(t)  +  SL(t). 

The  quantity  uj)’'(t)  is  bounded  because  the  arc  length  is  a  composition  of  smooth  function  in  t  and  the 
parametrization  of  the  boundary  dQ.  In  the  case  of  slowly  time- varying  boundary  the  variation  in  time 
of  the  vector  L(t)  is  due,  not  only  to  the  fact  that  the  agents  speed  up  and  slow  down  as  imposed  by  the 
algorithm,  but  also  to  the  deformation  of  dQ: 

L{t)  =  A{t)L{t)  +  Ud{t)  =  A{t)(L{t)  +  Uj(t))  -t  Udit), 

where  A{t)  =  A{ci, . . .  ,c„^),  while  Ui(t)  G  is  the  noise  due  to  the  fact  that  the  agents  do  not  know 

exactly  the  arc  length  distance  between  them  and  their  neighbors,  L,  but  just  an  estimate  through  the 


19 


interpolation  points,  L.  Using  the  change  of  variables  in  equation  (21),  and  recalling  that  A(t)l  =  0,  for  all 
t,  we  have: 

+  '5L(t)  =  A{t)5'L{t)  +  ^(t)(5ui(t)  +  Ud(t), 
where  du*  =  u,  —  Jt  follows  that 

(5L(t)  =  A{t)5'L{t)  +  A{t)6ui(t)  +  dud(t),  (29) 

with  Sud{t)  =  Ud{t)  —  uO"(t).  The  system  described  by  equation  (29)  is  input-to-state  stable  (with  input 
A{t)6ui{t)  +  6u{t)d)  because  (i)  the  unforced  system  is  exponentially  stable,  and  (ii)  the  right-hand-side 
of  (29)  is  differentiable  and  uniformly  globally  Lipschitz  in  dL  and  A{t)dui{t)  +  Su{t)d,  (see  [18]). 

The  ISS  property  guarantees  that  if  u^,  the  error  between  L  and  its  estimate  L,  is  small  and  if  u,;  is 
smaller,  then  the  agents  will  get  close  to  the  equilibrium  point  of  (28),  which  corresponds  to  have  the  agents 
uniformly  distributed  according  to  the  arc  length.  The  larger  nip  is  and  the  slower  the  deformation  of  dQ  is, 
then  the  smaller  and  are,  and  the  closer  to  0  the  disagreement  dL  will  get  asymptotically.  □ 

4.3  Simulations 

In  this  section  we  present  results  of  two  different  simulations  obtained  with  the  implementation  of  the  Esti¬ 
mate  Update  and  Pursuit  Algorithm.  In  the  hrst  simulation  the  boundary  dQ  is  time  invariant,  while 
in  the  second  is  time  varying. 

4.3.1  Time-invariant  boundary 

In  this  simulation  we  use  ria  =  3  sensing  agents  to  have  an  approximation  of  the  non-convex  boundary  dQ 
described  by  (18).  The  outcome  is  shown  in  Figure  8.  In  order  to  calculate  their  speeds,  the  sensing  agents 
use  Vo  =  1,  and  k  =  0.05.  The  saturation  function  for  the  speed  has  lower  limit  Vmin  =  0-5  and  upper 
limit  Umax  =  2.  The  number  of  interpolation  points  is  riip  =  30,  while  A  =  ^.  The  simulation  time  is 
50  seconds  and  the  sampling  time  0.01  seconds.  The  plots  in  Figure  8  corresponds  to  the  positions  of  the 
interpolation  points  and  the  sensing  agents  at  four  different  instants:  t  =  0,  t  =  20,  t  =  40,  and  t  =  50 
seconds.  The  interpolation  points  Pnow*  for  i  G  {1, . . . ,  n^}  coincide  with  the  positions  of  the  sensing  agents. 
The  other  interpolation  points  are  randomly  distributed  on  the  boundary.  In  the  last  frame  one  can  also  see 
the  approximating  polygon  and  how  close  it  is  to  the  actual  boundary. 

Since  the  pseudo-distance  D\  and  the  arc  length  L  can  be  calculated  after  the  simulation  is  completed, 
we  use  Dx  and  L  instead  of  their  estimate  D\  and  L  to  show  the  algorithm  performance.  Figure  9  does 
indeed  show  the  convergence  of  the  algorithm.  In  the  first  plot  we  can  see  that  the  consensus  on  the 
pseudo-distance  Dx{pi,pi+i),  between  any  two  consecutive  interpolation  points,  is  reached.  The  quantity 
maxjgji^  „jp}ZlA(pi,Pi_i_i)  —  minig{i_  IlA(Pi,Pi-i-i)  does  not  vanish  because  of  numerical  errors  in  the 
estimate  D\.  The  second  plot  shows  how  the  agents  get  uniformly  spaced  along  the  boundary.  The  steady 
state  values  of  the  arc  length  distances  oscillates  around  8.3  which  is  the  target  value.  The  noise  is  again  due 
to  the  fact  that  the  agents  only  estimate  the  arc  length  using  the  positions  of  the  interpolation  points. 

4.3.2  Slowly  time-varying  boundary 

In  this  simulation  we  used  Ua  =  3  sensing  agents  to  have  an  approximation  of  the  non-convex  boundary 
dQ{t)  described  by: 

7(0,  t)  =  (^2  (^I  -  +  (2  +  cos(IO7r0)  +  0.5  sin(4^0))  , 

with  9  €  [0,1),  tf  =  200  seconds  as  shown  in  Figure  10.  The  values  of  Vq,  k,  Vmin,  Umax  and  A  are  respectively: 
I,  0.05,  0.5,  2,  and  The  simulation  time  is  200  seconds,  the  sampling  time  O.OI  seconds.  The  plots  in 


20 


Figure  8:  This  figure  shows  four  different  instants  of  50  seconds  simulation  obtained  by  the  implementation  of  the 
Estimate  Update  and  Pursuit  Algorithm  with  =  3,  riip  =  30,  vq  =  1,  k  =  0.05,  A  =  ^.  dQ  is  time  invariant. 
The  sensing  agents  position  is  represented  by  the  triangles  and  are  initialized  to  be  on  the  boundary  dQ.  In  the  last 
frame  also  the  approximating  polygon  is  shown. 


Figure  9:  Estimate  Update  and  Pursuit  Algorithm  This  plots  refers  to  the  case  of  dQ  being  time-invariant.  In 
the  first  plot  from  right  it  is  shown  the  error  maxig^i  Dx{pi,Pi+i)  —  miuig^i  Dx{pi,Pi+i)  vs  time.  In  the 

second  plot  we  show  the  arc  length  distances  between  the  three  sensing  agents. 


21 


Initial  Configuration 


t  =  50  sec 


Figure  10:  This  figure  shows  four  different  instants  of  the  200  seconds  simulation  obtained  by  implementing  the 
Estimate  Update  and  Pursuit  Algorithm  with  ria  =  3,  nip  =  30,  vq  =  1,  k  =  0.05,  A  =  ^.  The  boundary  dQ 
is  slowly  time-varying  in  this  case.  The  sensing  agents  positions  are  represented  by  triangles  and  initialized  to  be  on 
the  boundary  dQ.  The  last  frame  also  shows  the  approximating  polygon. 


Figure  10  correspond  to  the  positions  of  the  interpolation  points  and  the  sensing  agents  at  four  different 
instants,  t  =  0,  t  =  50,  t  =  100,  and  t  =  200  seconds  respectively.  The  algorithm  is  initialized  with  the  agents 
on  the  boundary.  The  interpolation  points  Pnow»  coincide  with  the  positions  of  the  sensing  agents.  The  other 
interpolation  points  are  randomly  distributed.  In  the  last  frame  we  can  also  see  the  approximating  polygon 
and  how  close  to  the  actual  boundary  is.  From  the  frames  in  Figure  10  it  is  clear  that  the  sensing  agents  can 
adapt  as  dQ  changes. 

The  pseudo-distance  D\  is  well  defined  only  if  the  interpolation  points  belong  to  the  boundary  dQ. 
Since  the  boundary  changes  with  time,  the  interpolation  points  are  only  for  some  time  on  the  boundary 
after  a  sensing  agents  has  projected  them.  So,  we  consider  as  pseudo-distance  between  any  two  consecutive 
interpolation  points  in  a  certain  time  r  the  pseudo-distance  between  their  radial  projection  onto  dQ{T).  The 
disagreement  in  the  placement  of  the  interpolation  points,  where  D\  is  redefined  as  just  explained,  is  shown 
in  the  first  plot  of  Figure  11. 

The  arc  length  between  any  two  consecutive  sensing  agents  is  shown  in  the  second  plot  of  Figure  11.  The 
three  distances  increase  with  time  because  L{dQ),  the  total  length  of  the  boundary,  increases  with  time. 
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Figure  11:  Estimate  Update  and  Pursuit  Algorithm.  This  figure  refers  to  the  case  of  dQ  being  slowly  time- 
varying.  In  the  first  plot  from  the  right  we  shown  the  error  max^g^i  Dx{pi,Pi+i)  —  minig^i  Dx{pi,Pi+i) 

vs  time.  The  second  plot  shows  the  arc  length  distances  between  the  three  sensing  agents. 


5  Conclusions 

In  this  paper  we  have  addressed  the  problem  of  boundary  estimation  and  tracking  by  means  of  robotic  sensors. 
We  have  presented  algorithms  to  position  the  agents  or  interpolation  points  along  the  boundary  in  such  a  way 
as  to  obtain  an  approximating  polygon  with  some  optimality  features.  It  is  proven  that  the  best  approximating 
polygon  for  convex  bodies,  according  to  the  symmetric  difference  ,  is  the  polygon  whose  vertices  are 
uniformly  distributed  according  to  the  metric  f  p^/^{9)d0.  We  used  a  new  metric  D\=  j — 
that  differs  from  the  other  one  in  two  aspects.  Motivated  by  the  fact  that  p^^^(0)d6  for 

convex  bodies,  we  substitute  p  with  k  because  p  is  not  well  defined  for  a  non-convex  bodies.  We  further 
modified  the  metric  introducing  the  arc  length  so  that  for  any  two  non-coincident  points  the  pseudo-distance 
D\  is  always  different  from  zero.  In  our  first  ideal  scenario  the  agents  know  the  boundary.  The  corresponding 
algorithm  leads  the  robots  to  positions  that  are  uniformly  spaced  according  to  the  pseudo-distance  D\.  Using 
tools  from  network  consensus  analysis,  the  algorithm  is  proven  to  converge  for  large  communication  radiuses; 
simulations  illustrate  that  the  algorithm  converges  also  when  the  communication  range  is  limited. 

In  the  second  and  more  realistic  scenario,  the  mobile  agents  are  equipped  with  sensors  that  provide  local 
information  on  the  tangent  and  curvature  of  the  boundary.  The  second  algorithm  allows  the  robots  to  place 
a  set  of  interpolation  points  uniformly  spaced  according  to  the  estimate  of  the  pseudo-distance  D\.  The 
position  of  the  interpolation  points  is  stored  in  a  data  fusion  center  and  is  available  on-demand  to  the  agents. 
The  vertices  of  the  approximating  polygon  are  the  interpolation  point  positions.  The  algorithm  is  proven  to 
converge  even  if  the  boundary  is  slowly-moving.  As  in  the  first  scenario,  tools  from  consensus  analysis  allow 
us  to  prove  the  correctness  of  the  second  algorithm. 

NEW  PARAGRAPH 

The  existence  of  a  central  data  fusion  center  is  not  a  critical  ingredient  in  the  design  of  the  algorithm. 
Indeed,  one  can  envision  the  following  equivalent  scenario:  the  agents  communicate  the  updated  interpolation 
points  to  their  clockwise  neighboor,  instead  of  exchanging  them  with  the  data  fusion  center.  In  such  a 
distributed  setting,  a  stationary  user  could  reconstruct  the  approximating  polygon  by  communicating  to  all 
the  agents  as  they  pass  by  a  fixed  spatial  location.  Future  research  will  explore  this  idea  more  in  detail. 
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Name: 

Goal: 

Data: 


Requires: 


Estimate  Update  and  Pursuit  Algorithm 

Uniformly  distribute  the  interpolation  points  according  to  the  pseudo-distance 
D\,  and  the  sensing  agents  according  to  the  arc  length  L. 

Location  of  the  interpolation  points,  unitary  tangent  vector  at  dQ  at  those  points, 
last  value  of  D\  between  any  two  consecutive  interpolation  points,  local  tangent 
and  local  curvature  of  the  boundary  dQ. 

At  to  =  0  Pi  lie  on  dQ  and  D\  between  any  two  interpolation  points  is  known. 


Assume  data  is  as  stated  in  (19).  At  every  sensing  instant,  the  agent  at  position  Pi{t)  =  P{t)  performs: 

1:  if  Dx{oL+i,P{t))  >  2£)^(pnow-i,13now),  then 

2:  update  the  set  of  observations  nextbuffer+  :=  nextbuffer  U  {P(t)}, 

3:  else 

4:  update  the  set  of  observations  bufferarc’*'  :=  bufferarc  U  {P(t)}. 

5:  end  if 

6:  estimate  j'{P{t)),  K{P{t)),  and  Dx{ol+m+t,  P{t)). 

7:  if  NEXTBUFFER  ^  0  and  Pnow*  ^  Pnow*+i-2  then 

8:  update  the  interpolation  point  Pnow  by  projecting  it  onto  dQ\ 

PnOW  •“  ^jl  ~  S'^S^i^Oj-eBUFFERARO  11(^1  ~  PnOw)  '  tfjowll) 

9:  update  the  set  bufferarc  and  generate  the  set  nowarc  by: 

BUFFERARC+  :=  BUFFERARC  \  {ol+1,  ■  •  •  ,  Oj}, 

NOWARC+  :=  {0L+l,...,0j}, 

10:  calculate  Gnow-i  :=  and  update  Pnow-i  by  p^ow-i  ■=  Ok, 

11:  communicate  with  data  center:  transmit  Pnow-i,  Pnow,  7'(Pnow-i)5  -C)a(pnow-25Pnow-i), 

Dx{p  NOW— 1 ;  Pnow)  and  receive  Pnow+i,  7'(pnow+i),  Dx{p  NOW)  PnOW+i)) 

12:  update  the  counter  NOW  and  the  set  lastarc  by 

NOW+  :=  NOW  -I-  1,  LASTARC :=  {o^,  .  .  .  ,  Oj}, 

13:  update  the  sets  bufferarc  and  nextbuffer  as  follows: 

14:  if  3oq  G  bufferarc  U  nextbuffer  >  2Z1a(pnow+-1)Pnow+)>  then 

15:  BUFFERARC+  :=  {oj+i,  .  .  .  ,  Og},  NEXTBUFFER+  :=  {o,+i,  .  .  .  ,  Ol+M+t}, 

16:  else 

17:  BUFFERARC+  :=  BUFFERARC  U  NEXTBUFFER,  NEXTBUFFER+  :=  0. 

18:  end  if 

19:  end  if 

20:  communicate  with  Pi+i  and  Pi-i'.  receive  NOW*’*'^,  NOW*“^,  transmit  now*.  Communicate  with  the 
data  center:  receive  the  positions  of  the  interpolation  points  with  id  between  NOW*“^  and  NOW*+^. 

21:  calculate  Vi (t):  Vi{t)  =  sat{vo  +  k{L{Pi,  Pi^i)  —  L{Pi_i,  Pi))). 
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